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In  this  paper,  a  novel  strapdown  stellar-inertial  guidance  scheme  is  developed  to  correct  the  velocity 
and  position  navigation  errors  for  responsive  launch  vehicle.  Three  types  of  error  sources  consisting  of 
initial  localization  and  misorientation  errors,  inertial  sensor  errors  and  gravity  computation  errors  due  to 
position  navigation  errors  are  discussed.  The  digital  platform  error  model  arising  from  initial  localization 
and  misorientation  errors  and  gyro  measurement  error  is  derived.  The  detailed  analysis  for  the  velocity 
and  position  navigation  errors  caused  by  initial  position  errors,  digital  platform  errors,  accelerometer 
measurement  error  and  gravity  computation  errors  is  performed.  For  the  gravity  computation  errors 
due  to  the  position  navigation  errors,  an  effective  first-order  approximation  compensation  scheme  is 
addressed.  A  dual  star  correction  strategy  scheme  is  presented  to  estimate  the  error  parameters  and 
correct  the  cumulative  velocity  and  position  navigation  errors.  Compared  with  traditional  stellar-inertial 
guidance  algorithm  based  on  nominal  trajectory  data  and  priori  subsystem  error  statistics,  the  proposed 
algorithm  uses  the  real-time  trajectory  data  to  calculate  the  function  matrices  used  in  the  navigation 
error  propagation  equations.  Thus,  the  corrections  for  velocity  and  position  navigation  errors  are  provided 
by  the  stringent  navigation  error  model  rather  than  the  statistics  of  the  subsystem  errors  caused  by 
individual  error  source.  Numerical  examples  are  given  to  analyze  the  effects  of  the  individual  error  factor 
with  respect  to  the  accuracy  of  strapdown  INS  and  compare  the  navigation  performances  for  all-inertial, 
stellar-inertial,  and  stellar-inertial  plus  gravity  compensation  guidance  schemes. 

©  2014  Elsevier  Masson  SAS.  All  rights  reserved. 


1.  Introduction 

The  keystone  of  the  operationally  responsive  space  (ORS)  con¬ 
cept  is  a  responsive  launch  capability  [1],  Responsive  launch  spec¬ 
ifies  the  reduction  of  launch-vehicle  call-up  times  from  months  to 
days  and  of  final  preparation  and  launch  from  days  to  hours,  which 
offers  the  potentially  capability  to  inject  the  payload  into  orbit  in 
several  hours.  One  of  the  key  technologies  for  responsive  launch 
is  the  high-precision  navigation  and  guidance  technique.  Several 
typical  navigation  systems  used  on  launch  vehicles  include  inertial 
navigation  system  (INS),  radio  navigation  system,  global  naviga¬ 
tion  satellite  system  (GNSS)  and  celestial  navigation  system  (CNS). 
An  INS  is  a  self-contained  autonomous  navigation  system  which 
uses  gyroscopes  and  accelerometers  to  provide  attitude  informa¬ 
tion  in  addition  to  position  and  velocity.  However,  INS’s  rely  on 
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the  availability  of  accurate  knowledge  of  the  initial  state,  and  the 
accumulated  navigation  errors  grow  without  bound  due  to  the  in¬ 
ertial  sensor  errors.  Therefore,  the  integrated  guidance  schemes  are 
usually  used  to  improve  the  guidance  accuracy,  and  two  typical 
schemes  are  the  integrated  INS/GNSS  and  INS/CNS  schemes.  An  in¬ 
tegrated  INS/GNSS  uses  an  optimal  estimator  to  fuse  the  GNSS  and 
INS  positioning  and  navigation  information  to  yield  a  reliable  nav¬ 
igation  solution.  But  this  integrated  scheme  is  subject  to  the  work 
performance  of  the  satellites,  and  the  high-precision  attitude  mea¬ 
surements  from  GNSS  are  still  not  available  until  now.  In  compari¬ 
son  with  the  INS/GNSS  integration,  an  integrated  INS/CNS  scheme, 
also  called  as  stellar-inertial  guidance  scheme,  has  the  advantages 
of  good  automatic  navigation  and  concealment  performances  as 
well  as  the  capability  to  correct  for  the  attitude  errors. 

Compared  with  all-inertial  guidance  systems,  the  major  advan¬ 
tages  of  stellar-inertial  guidance  systems  are  quick  reaction  capa¬ 
bility,  the  ability  to  correct  for  initial  position  and  launch  azimuth 
errors,  and  relatively  low  cost  [11],  The  basic  principle  of  the 
stellar-inertial  guidance  system  is  to  calibrate  the  inertial  naviga¬ 
tion  system  using  the  accurate  orientation  information  provided  by 
stellar  sensor,  which  can  relax  the  demands  of  localization  and  ori¬ 
entation  for  launch  vehicle  at  launch  and  sequentially  reduce  the 
preparation  time.  It  has  been  successfully  applied  in  the  subma¬ 
rine  launched  ballistic  missile  (SLBM)  systems,  such  as  Trident  I 
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Nomenclature 

ORS  operationally  responsive  space 

SLBM  submarine  launched  ballistic  missile 

INS  inertial  navigation  system 

GNSS  global  navigation  satellite  system 

CNS  celestial  navigation  system 

ECEF  Earth-Centered-Earth-Fixed  (E-frame) 

LCI  Launch-Centered-Inertial  (/-frame) 

LCEF  Launch-Centered-Earth- Fixed  (G -frame) 

DCM  direction  cosine  matrix 

EKF  extended  Kalman  filter 

(Afi [-].  Af2[-].  AI3 [■])  attitude  transformation  matrices  rotating 
about  x,  y,  z  axes,  respectively 
hx3  3x3  identity  matrix 

(Ao,  Bo,  ao,  ho)  nominal  launch  azimuth,  latitude,  longitude, 
and  height  of  launch  site 

(AAo,  ABo,  Aa0)  initial  launch  azimuth,  latitude  and  longitude 
errors 

A  initial  localization  and  misorientation  error  vector 

a  a  initial  digital  platform  error  caused  by  the  initial  local¬ 

ization  and  misorientation  errors 
otg  digital  platform  error  caused  by  the  gyro  measurement 

a  total  misalignment  angle  or  digital  platform  error  vec¬ 

tor 

<Wg/f  angular  velocity  vector 

S(Ogp  gyro  measurement  error 

Dg  gyro  error  coefficients 

SfB  accelerometer  measurement  error 

Da  accelerometer  error  coefficients 

Aro  initial  position  navigation  error 

A  Vo  initial  velocity  navigation  error 

WB  output  apparent  acceleration  expressed  in  the  body 

frame 


W1  true  apparent  acceleration  expressed  in  the  I  frame 

AIV  apparent  acceleration  measurement  error 

Al/Vf  apparent  velocity  navigation  error 

Ar1  apparent  position  navigation  error 

Ag1  gravity  computation  error  due  to  the  position  naviga¬ 
tion  errors 

X 1  navigation  position  vector  expressed  in  the  theory  LCI 

frame 

X1'  true  position  vector  expressed  in  the  actual  LCI  frame 
p'0  position  vector  from  the  Earth  center  to  the  nominal 
launch  site  expressed  in  the  theory  LCI  frame 
p[Q,  position  vector  from  the  Earth  center  to  the  actual 
launch  site  expressed  in  the  actual  LCI  frame 
A  vg  velocity  navigation  error  due  to  the  gravity  computa¬ 
tion  errors 

A rg  position  navigation  error  due  to  the  gravity  computa¬ 
tion  errors 

Av  total  velocity  navigation  errors 

Ar  total  position  navigation  errors 

t  flight  time,  to  =  0 

tfc  shut  down  time 

£{■}  expectation 

c oe  earth  rotation  rate 

e  earth  eccentricity 

&k  estimate  of  the  digital  platform  misalignment  angle  at 
shut  down  time 

a  o  estimate  of  the  initial  digital  platform  misalignment 
angle 

co’  Va’  Vs)  gyro,  accelerometer  and  star  sensor  measurement 
noises,  respectively 

(cr®,  era,  <?s)  gyro,  accelerometer  and  star  sensor  measurement 
noise  strengths,  respectively 


missile  of  America  [20],  and  SS-N-8,  SS-N-18  and  SS-N-20  mis¬ 
siles  of  Soviet  Union  [4],  In  view  of  the  similarity  of  launch  vehicle 
and  ballistic  missile,  the  stellar-inertial  guidance  scheme  is  intro¬ 
duced  into  launch  vehicles  to  satisfy  the  requirements  of  respon¬ 
sive  launch. 

In  terms  of  the  mounting  position  of  the  inertial  sensors,  the 
INS’s  are  typically  divided  into  gimbaled  INS  and  strapdown  INS. 
In  the  gimbaled  INS,  the  inertial  sensors  are  mounted  on  a  sta¬ 
ble  platform  which  is  stabilized  in  space,  while  in  the  strap- 
down  INS,  the  inertial  sensors  are  directly  mounted  on  the  vehicle 
[19],  Therefore,  the  corresponding  stellar-inertial  guidance  systems 
fall  into  gimbaled  and  strapdown  stellar-inertial  systems.  For  a 
gimbaled  system,  the  stellar  sensor  is  mounted  with  the  inertial 
platform  and  the  inertial  reference  frame  is  maintained  by  clus¬ 
ter;  while  for  a  strapdown  system,  the  stellar  sensor  is  integrally 
mounted  with  vehicle  itself  and  the  inertial  reference  frame  is 
maintained  by  the  flight  computer  software.  Actually,  many  con¬ 
cepts  discussed  in  these  two  stellar-inertial  guidance  systems  are 
not  different,  and  the  most  significant  difference  lies  in  the  mech¬ 
anization  of  the  stellar  sighting  itself  [11].  Although  the  strapdown 
INS  is  not  comparable  to  gimbaled  INS  in  the  degree  of  accu¬ 
racy  presently,  it  has  obvious  advantages  in  the  flexibility  and  cost 
which  satisfy  the  requirements  of  responsive  launch.  Therefore, 
strapdown  stellar-inertial  guidance  scheme  has  become  an  impor¬ 
tant  research  direction  in  the  inertial  guidance  area. 

In  the  early  open  literature,  only  the  basic  principle  of  the 
stellar-inertial  guidance  system  was  introduced,  but  the  detailed 
models  and  methods  were  not  discussed  [11,7,6,5].  For  the  gim¬ 


baled  stellar-inertial  system,  a  single-star  scheme  has  been  pre¬ 
sented  in  [2],  In  recent  years,  Zhang  et  al.  further  presented 
the  concept  of  equivalent  information  compression  to  explain  the 
implementation  principle  of  the  single-star  stellar-inertial  guid¬ 
ance  technique  [25]  and  studied  the  application  of  this  guidance 
scheme  to  responsive  launch  vehicle  [24],  However,  in  [24],  only 
the  positioning  and  orientation  errors  but  no  inertial  sensor  er¬ 
rors  were  taken  into  consideration.  In  addition,  the  analysis  of  the 
error  factors  affecting  the  INS  and  the  correction  scheme  were 
not  discussed  in  depth.  For  the  strapdown  stellar-inertial  system, 
an  integrated  INS/CNS  navigation  algorithm  using  the  neural  net¬ 
work  Kalman  filter  was  addressed  by  Xu  and  Fang  [23]  and  a 
strapdown  inertial/starlight  integrated  guidance  scheme  for  ballis¬ 
tic  missiles  was  presented  by  Wang  [22],  In  [23],  the  prelaunch 
position  and  azimuth  uncertainties  which  are  essentially  the  pri¬ 
mary  error  sources  resulting  in  the  velocity  and  position  naviga¬ 
tion  errors  during  the  boost  phase  were  not  considered.  In  [22], 
the  prelaunch  azimuth  errors  were  not  considered,  and  the  ef¬ 
fects  of  the  prelaunch  position  errors  with  respect  to  navigation 
computation  frame  were  not  analyzed.  Unfortunately,  in  both  ref¬ 
erences,  the  computations  for  the  error  propagation  transition  ma¬ 
trix,  which  are  used  to  correct  the  cumulative  velocity  and  position 
navigation  errors,  were  vague  and  cumbersome. 

In  this  paper,  three  types  of  error  sources  affecting  the  strap- 
down  INS  are  discussed  in  detail.  They  are  initial  localization  and 
misorientation  errors  (i.e.  prelaunch  position  and  azimuth  errors), 
inertial  sensor  errors  and  the  gravity  computation  errors  due  to  the 
position  navigation  errors.  The  inertial  sensor  errors  are  referred 
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to  as  gyro  and  accelerometer  sensor  errors.  A  more  general  inertial 
sensor  error  model  including  drifts,  scale  factors,  misalignments 
and  measurement  noises  is  used  [10,8],  The  principal  software 
functions  executed  in  the  strapdown  INS  computer  (i.e.,  digital 
platform)  are  the  integration  of  angular  rate  into  attitude,  accelera¬ 
tion  transformation  and  integration  into  velocity,  and  integration  of 
velocity  into  position  [12],  Due  to  the  initial  localization  and  mis- 
orientation  errors  as  well  as  gyro  measurement  error,  there  exist 
misalignment  errors  between  the  computation  frame  and  naviga¬ 
tion  frame  which  are  called  as  digital  platform  errors.  It  is  evident 
that  the  velocity  and  position  navigation  results  are  affected  by 
digital  platform  errors,  initial  position  errors  and  accelerometer 
measurement  error.  Besides,  since  the  gravitation  acceleration  is 
computed  using  the  navigation  information,  there  are  computation 
errors  in  the  gravity  computation  due  to  the  position  navigation 
errors,  which  consists  of  initial  position  errors  and  cumulative  po¬ 
sition  errors  during  the  boosted  flight.  The  navigation  accuracy  can 
be  improved  if  this  type  of  error  source  compensated,  particular 
for  the  velocity  navigation  result.  Since  the  flight  time  is  not  long, 
the  navigation  errors  caused  by  inertial  sensors  are  generally  not 
large  and  the  initial  localization  and  misorientation  errors  are  the 
primary  error  factors  resulting  in  the  navigation  errors  among  oth¬ 
ers.  Therefore,  it  is  necessary  to  decrease  the  prelaunch  position 
and  azimuth  errors  if  possible. 

Traditional  stellar-inertial  guidance  algorithm  [11,5],  which  uses 
a  precomputed  (9x2)  gain  matrix  to  correct  the  nine  components 
of  position  and  velocity  as  well  as  attitude  or  a  2  x  2  matrix  to 
correct  down-range  and  cross-range  miss  directly,  is  based  on  the 
nominal  trajectory  data  and  priori  subsystem  error  statistics.  When 
the  INS  is  affected  by  more  than  one  type  of  error  source,  in  gen¬ 
eral,  not  the  perfect  coefficients  but  merely  the  statistically  optimal 
weighting  coefficients  can  be  calculated  a  priori.  In  order  to  solve 
this  problem,  this  paper  performs  a  detailed  analysis  of  the  men¬ 
tioned  three  types  of  error  source  behaviors  as  applied  to  launch 
vehicle  flight,  and  presents  a  dual  star  correction  strategy  scheme 
to  estimate  the  error  parameters  and  correct  the  cumulative  veloc¬ 
ity  and  position  navigation  errors.  In  this  stellar-inertial  guidance 
scheme,  the  function  matrices  used  in  the  navigation  error  prop¬ 
agation  equations  are  computed  by  using  the  real-time  flight  data 
rather  than  the  nominal  trajectory  data,  and  the  selection  of  the 
optimal  stellar  sighting  direction  does  not  need  to  be  considered. 

This  paper  is  outlined  as  follows.  In  Section  2,  the  various  ref¬ 
erence  frames  used  in  stellar-inertial  guidance  system  are  firstly 
summarized.  Then,  a  detailed  analysis  for  digital  platform  errors 
resulting  from  prelaunch  position  and  azimuth  errors  as  well  as 
gyro  measurement  error  is  performed,  and  the  stringent  digital 
platform  error  model  is  formulated.  Section  3  derives  a  detailed 
mathematics  model  for  navigation  errors  caused  by  initial  po¬ 
sition  errors,  digital  platform  errors,  accelerometer  measurement 
error,  and  gravity  computation  errors  due  to  the  position  naviga¬ 
tion  errors.  A  compensation  scheme  for  the  gravity  computation 
errors  due  to  the  position  navigation  errors  is  addressed.  In  Sec¬ 
tion  4,  a  dual  star  correction  strategy  scheme  is  presented  to  esti¬ 
mate  the  error  parameters  and  correct  for  the  cumulative  velocity 
and  position  navigation  errors.  In  Section  5,  simulation  results  are 
presented  that  analyze  the  effects  of  the  individual  error  factor 
with  respect  to  strapdown  INS  and  compare  the  navigation  per¬ 
formances  for  all-inertial,  stellar-inertial,  and  stellar-inertial  plus 
gravity  compensation  guidance  schemes. 

2.  Reference  frames  and  digital  platform  error  analysis 

2.1.  Reference  frames 

In  this  section  the  reference  frames  used  in  this  paper  are  sum¬ 
marized,  as  shown  in  Fig.  1 : 


(1)  Earth-Centered-Earth-Fixed  (ECEF)  Frame  (E-frame):  The 
frame  has  its  origin  at  the  center  of  the  Earth  and  axes  which 
are  fixed  with  respect  to  the  Earth.  The  z  axis  points  in  the  di¬ 
rection  of  the  North  pole,  the  x  axis  points  in  the  direction  of  the 
Earth’s  prime  meridian,  and  the  y  axis  completes  the  right-handed 
system. 

(2)  Launch-Centered-Inertial  (LCI)  Frame  (/-frame):  The  frame 
is  inertially  fixed  and  is  centered  at  launch  site  at  the  instant  of 
launch.  In  this  system,  the  x  axis  is  taken  to  be  in  the  horizontal 
plane  and  in  the  direction  of  launch,  the  positive  y  axis  vertical, 
and  the  z  axis  completing  the  right-handed  coordinate  system. 

(3)  Launch-Centered-Earth-Fixed  (LCEF)  Frame  (G-frame):  This 
is  an  Earth-fixed  coordinate  system,  having  the  same  orientation 
as  the  LCI  frame. 

(4)  Navigation  Computation  Frame  (P-frame):  In  a  strapdown 
system,  the  frame  is  a  virtual  digital  platform  frame  which  has  its 
origin  at  the  location  of  strapdown  INS  and  axes  aligned  with  the 
directions  of  LCI  frame. 

(5)  Body  Frame  (B-frame):  This  frame  is  fixed  onto  the  vehicle 
body  and  rotates  with  it.  The  positive  x  axis  coincides  with  the  ve¬ 
hicle’s  center  line  or  longitudinal  axis.  The  positive  z  axis  is  to  the 
right  of  the  x  axis  in  the  horizontal  plane  and  designated  as  pitch 
axis.  The  y  axis  is  the  yaw  axis  and  completes  the  right-handed 
system. 

Herein  two  LCI  frames  are  defined,  one  is  the  theory  LCI  frame 
(/-frame),  and  the  other  is  the  actual  LCI  frame  (/'-frame).  The  the¬ 
ory  LCI  frame  is  established  on  the  nominal  launch  site  and  is 
referred  to  as  guidance  frame  stored  in  the  navigation  computer, 
while  the  actual  LCI  frame  is  established  on  the  actual  launch  site. 
Since  the  prelaunch  position  and  azimuth  are  with  errors,  there 
are  the  misorientation  errors  between  the  theory  and  actual  LCI 
frames.  During  the  actual  flight,  the  gyro  measurement  error  also 
leads  to  the  misorientation  errors  between  the  navigation  compu¬ 
tation  frame  (P-frame)  and  theory  LCI  frame  (/-frame).  Therefore, 
there  exist  misalignment  errors  between  the  P  frame  and  the  / 
frame,  which  are  called  as  digital  platform  errors.  For  small  angles 
of  misalignment,  the  misalignment  of  the  P  frame  relative  to  the  / 
frame  can  be  described  using  misalignment  angle  a  as  [16] 

R,  =  I3x3  -  [«x]  (1) 

where  Ijx-}  is  a  3  x  3  identity  matrix,  [ax]  is  a  cross  product 
matrix  defined  by 

I"  0  ~(XZ  dy  1 
[ax]  =  az  0  -a* 

|_-ay  ax  0  J 


(2) 
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The  main  error  factors  affecting  the  inertial  navigation  results 
include  initial  localization  and  misorientation  errors  (i.e.  prelaunch 
position  and  azimuth  errors)  and  inertial  sensor  errors.  The  inertial 
sensor  errors  are  referred  to  as  gyro  and  accelerometer  measure¬ 
ment  errors.  The  effects  of  the  initial  localization  and  misorienta¬ 
tion  errors  are  divided  into  two  parts:  one  part  is  to  induce  the 
digital  platform  errors,  and  the  other  part  is  to  induce  the  initial 
velocity  and  position  navigation  errors.  As  mentioned  above,  the 
digital  platform  errors  are  caused  by  the  initial  localization  and 
misorientation  errors  and  gyro  measurement  error.  The  stellar  up¬ 
date  algorithm  uses  the  star  sensor  measurements  to  estimate  the 
digital  platform  errors.  Obviously,  the  velocity  and  position  naviga¬ 
tion  errors  are  caused  by  digital  platform  errors,  initial  localization 
and  misorientation  errors  as  well  as  accelerometer  measurement 
error.  In  addition,  the  gravitational  acceleration  computation  errors 
due  to  the  position  navigation  errors  also  cause  velocity  and  posi¬ 
tion  navigation  error,  and  the  navigation  accuracy  can  be  further 
improved  if  these  errors  compensated.  Therein-after,  the  digital 
platform  errors  are  discussed  in  detail  and  the  detailed  analysis  for 
the  navigation  errors  will  be  performed  in  Section  3.  Fig.  2  shows 
the  navigation  error  analysis  of  strapdown  INS. 

2.2.  Digital  platform  errors  caused  by  initial  localization  and 
misorientation  errors 


where  Rf  (0)  is  the  transpose  matrix  of  r'e( 0).  Since  the  the¬ 
ory  and  actual  LCI  frames  are  both  inertial  reference  frames,  the 
attitude  error  matrix  Rj  does  not  change  with  time.  For  small 
angles  of  attitude  errors,  the  attitude  error  matrix  also  can  be  ex¬ 
pressed  as 

Rf  =  /3x3-[aAx]  (6) 

where  a  a  is  the  initial  digital  platform  error  caused  by  the  initial 
localization  and  misorientation  errors. 

Comparing  Eqs.  (5)  and  (6)  yields 

[  aAx~\  [  0  -sinA0  cos  A0cosB0  1  AA0 1 

ctA  —  01  Ay  =  -1  0  sin  Bo  ABo 

|_«AzJ  0  -cos>1o  —  sinA0cosB0J  |_  AA.0  J 

=  NaA  (7) 

It  is  shown  from  Eq.  (7)  that  the  determinant  of  N a  is  cos  Bo. 
In  general,  the  latitude  of  launch  site  is  not  equal  to  90°  or  —90° 
and  thus  the  matrix  JVa  can  be  inversed.  Therefore,  the  initial  lo¬ 
calization  and  misorientation  errors  A  can  be  uniquely  determined 
when  obtaining  a  a- 

2.3.  Digital  platform  errors  caused  by  gyro  measurement  error 


Since  the  LCI  frame  coincides  with  the  LCEF  frame  at  the  in¬ 
stant  of  launch,  the  initial  ECEF-to-LCI  attitude  matrix  equals  the 
ECEF-to-LCEF  attitude  matrix,  that  is  [18] 

Rg(0)  =  Rge  =  JVf2[— (90°  +  A0)]M1[Bo]M3[Ao  -  90°]  (3) 

where  A0,  B0,  a0  are  the  nominal  launch  azimuth,  latitude  and 
longitude  of  launch  site,  respectively;  JVfi[  ],  M2[-],  M3[-]  are  the 
attitude  transformation  matrices  rotating  about  x,  y,  z  axes,  re¬ 
spectively. 

Considering  the  effects  of  the  initial  localization  and  misorien¬ 
tation  errors,  the  direction  cosine  matrix  (DCM)  relating  the  ECEF 
frame  and  the  actual  LCI  frame  is  given  by 

r£(0)  =  M2[-(90°  +  A0  +  AAo)]Mi[Bo  +  AB0] 

xM3[A.  o  +  AAo-900]  (4) 

where  AAo,  ABo,  Aaq  are  the  launch  azimuth,  latitude  and  lon¬ 
gitude  errors,  respectively.  These  errors  can  be  described  in  vector 
form  as  A  —  [AAo  ABo  AA.o]T. 

By  using  Eqs.  (3)  and  (4)  and  first-order  approximation,  we  ob¬ 
tain 


R{'  =  4'(0)Rf(0) 


(5) 


Since  the  LCI  frame  is  selected  as  the  navigation  frame,  the  at¬ 
titude  ldnematics  equation  is  given  by  [15] 

=  *{,[«!/,  x]  (8) 

where  Rg  is  the  transformation  matrix  from  the  B  frame  to  the  I 
frame  and  <y^(  is  angular  velocity  of  the  B  frame  relative  to  the  I 
frame  expressed  in  the  B  coordinates. 

When  computing  the  attitude  matrix  Rg,  the  actual  computa¬ 
tion  result  contains  the  error  term  5Rg  since  the  output  angular 
velocity  is  contaminated  by  the  gyro  measurement  error.  Thus,  the 
actual  computation  result  RB  is  given  by 

rJ^r'j  +  SR'j  (9) 

In  fact,  the  navigation  computation  result  Rg  is  equivalent  to 
the  attitude  matrix  Rg  provided  by  strapdown  INS  which  maps 
the  B  frame  to  the  P  frame,  which  can  be  expressed  as 

Rg  =  Rg  =  R^  Rg  =  (/3x3  —  [wx])Rg  (10) 

Comparing  Eqs.  (9)  and  (10)  gives 
«R£  =  -[ax]R{,  (11) 

By  differentiating  Eq.  (11)  and  using  Eq.  (8),  we  have 
5Rg  =  -[dx]R^-[ax]Rg 

=  — [ax]Rg  —  [ax]Rg[w|/7x] 


(12) 
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On  the  other  hand,  taking  the  perturbation  on  the  both  sides  of 
Eq.  (8)  and  using  Eq.  (11)  yields 

J«;=«R'[4,x]  +  r'[j4,x] 

=  -[ux]R'b[(OBb/ix]  +  R'b[8c0Bb/ix]  (13) 

Equating  Eqs.  (12)  and  (13)  gives 


—  J  ^B^gyro  dtDg  +  J N gyro ^gX  Joe  dt 
0  0 

RgJVgyro  dtDg  =  NgDg 


[ax}  =  -R'B[S(oBB/lx]  RB  (14) 

where  Rf  is  the  transpose  matrix  of  R!B  and  &(dB/,  is  the  gyro 
measurement  error. 

Rearranging  Eq.  (14)  gives  the  following  vector  form 
6c  =  —RBS(oB/i  (15) 

Therefore,  we  obtain  the  digital  platform  error  by  taking  the 
integral  of  a  over  time.  Mathematically, 


(16) 


where  RB  is  the  navigation  computation  result  provided  by  strap- 
down  INS.  It  can  be  seen  from  Eq.  (22)  that  ag  is  an  approximate 
linear  function  of  Dg.  Furthermore,  it  follows  from  Eqs.  (17),  (7) 
and  (22)  that  the  term  _/0r[J?gNgyroDsx]Q!  dt  is  a  second-order 
small  quantity  and  the  approximation  on  the  right  side  of  Eq.  (22) 
is  reasonable.  Since  the  true  angular  velocity  is  not  available,  the 
gyro  measured  rate  is  used  to  substitute  for  the  true  rate  when 
computing  matrix  Ngyro.  In  fact,  the  second-order  error  effect 
caused  by  this  approximation  can  be  neglected. 

Inserting  Eqs.  (7)  and  (22)  into  Eq.  (17),  the  total  misalignment 
angles  can  be  expressed  as 

cc=NaI(  (23) 


where  t  is  the  flight  time.  From  the  previous  analysis,  it  can  be 
seen  that  the  digital  platform  error  at  time  t  =  0  is  essentially  the 
misalignment  error  of  the  1'  frame  relative  to  the  I  frame.  Thus, 
Eq.  (16)  becomes 


JV«  =  [NA  Ng  03xi2  ]  (24) 

I(  =  [At  DJg  D*]1  (25) 


a  =  aA  +  ag  (17) 

where  otg  —  —  R^SoOg^dt  is  defined  as  the  digital  platform  er¬ 
ror  caused  by  the  gyro  measurement  error. 

The  optic  fiber  gyro  measurement  error  model  is  given  by 


where  K  is  the  error  parameter  vector  to  be  determined,  and  D„ 
is  the  12-dimension  error  coefficients  of  the  accelerometers  which 
will  be  defined  in  Section  3. 

3.  Navigation  error  analysis 


[DqX  +  DxxO)x  +  Dxy(Oy  +  Dxza>z  ~\ 

Doy  +  DyXCOX  +  Dyy(Oy  +  D  yZCOZ  +  Tf  ^ 

Doz  +  Dzxa>x  +  Dzyo)y  +  Dzza>z  J 
=  N  gyroDg  +  (18) 

with 

[  1  cox  coy  coz  0  0  0  0  00  0  0  1 

Ngyro  =  00  0  0  1  cox  a)y  coz  0  0  0  0 

|_00  0  0  00  0  0  \  a)x  (oy  Q)z\ 

(19) 

Dg  =  [  Do*  Dx*  Dxy  Dxz  D0y  Dyx  Dyy  Dyz  D0z  Dzx  Dzy  Dzz  ]T 

(20) 

where  Dqx,  Doy,  Dqz  are  the  gyro  drifts;  Dxx,  Dyy,  Dzz  are  the 
scale  factors;  Dxy,  Dxz,  Dyx,  Dyz,  Dzx,  Dzy  are  the  misalignments. 
Measurement  noise  i)m  is  zero-mean  Gaussian  white-noise  pro¬ 
cesses  with  spectral  densities  given  by  <t^/3X3- 
Substituting  Eq.  (18)  into  the  variable  ag  gives 

«g  =  -f  R'B(NgyroDg  +  iiJdt^- J  RB  Ngyro  dtDg  (21) 
0  0 

Since  the  true  attitude  matrix  RB  is  not  available  during  the 
flight,  Eq.  (21)  needs  to  be  further  rewritten  by  using  the  available 
navigation  result  RB  as 

0Cg  =  —J  (l3x3  +  [«x])Rg  Ngyro  dtDg 


In  this  section,  a  detailed  analysis  for  the  position  and  veloc¬ 
ity  navigation  errors  is  performed  and  an  effective  compensation 
scheme  for  the  gravity  computation  errors  due  to  the  position  nav¬ 
igation  errors  is  addressed.  As  illustrated  in  Fig.  2,  the  position 
and  velocity  navigation  errors  are  caused  by  initial  position  errors, 
digital  platform  errors,  accelerometer  measurement  error  and  grav¬ 
ity  acceleration  computation  errors.  The  corresponding  effects  with 
respect  to  strapdown  INS  are  discussed  in  the  following  context.  In 
this  paper,  the  navigation  errors  are  defined  as  the  errors  that  nav¬ 
igation  position  and  velocity  in  the  theory  LCI  frame  minus  true 
position  and  velocity  in  the  theory  LCI  frame. 

3.1.  Navigation  errors  caused  by  initial  position  errors 

The  ECEF  position  coordinates  of  launch  site  are  computed  us¬ 
ing  [3] 

xE  =  (N  +  ho)  cos  B0  cos  Xo 
yE  =  (N  + ho)  cos  B0  sin  X0 

zE  =  [N(l-e2)+h0]sinB0  (26) 

where  B0.  T-o.  ho  are  latitude,  longitude,  height  of  launch  site,  and 
N  is  the  length  of  the  normal  to  the  ellipsoid,  given  by 

N=  °  =  (27) 

Y 1  -  e2  sin2  B0 

where  a  =  6,378,137.0  is  the  Earth  semimajor  axis  and  e  =  0.0818 
is  the  earth  eccentricity. 

Taking  the  partials  of  the  quantities  in  Eq.  (26)  with  respect  to 
B o,  ao,  and  ho,  which  leads  to  the  following  partial  matrix  [3]: 
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=] 


dN 


ae2  sin  Bo  cos  Bo 


(29) 


9fio  (l-e2sin 2  B0)3/2 

Since  the  height  ho  is  generally  measured  exactly,  the  effect  of 
height  error  can  be  ignored.  Therefore,  the  ECEF  position  errors 
can  be  described  by  using  initial  localization  and  misorientation 

f  Axe 


Ay1 
|_  Azl 


H 

,£ 

£J 


-(IV  +  ho)  co 
(IV  +  h0)  cos 


=  HA 


=  r'e(0MA  = 


Av0  =  -[w'x]PA  = 


>e  =  «->e  [ 


as  Bo  cos  Ao  sin  Bo  - 
s  the  Earth’s  rotation  r 


os  Bo  sin  Ao  ] 
a  given  as  7.292115 


The  measurement  error  of  the  apparent  acceleration,  AW  ,  is 
expressed  in  the  theory  LCI  frame  as 


(39) 


jgt  cos  B o  cos  lo  —  (N  +  ho)  sii 
cos  Bo  sinlo  —  (N  +  ho)  sii 
£(l-e2)sinB0  +  [N(l-e2)- 

r  a^0  i 

x  AB0  = 

L  A^o  J 

Since  the  navigation  errors  are  defined  in  the  theory  LCI  frame, 
the  ECEF  position  errors  are  then  transformed  into  the  theory  LCI 
frame,  expressed  as 


(30) 


AH/1  =  W  -W1  =  RpbWB  -  R'b(WB -SfB) 


where  W  and  W  are  the  measured  and  true  values  of  the 
apparent  acceleration  expressed  in  the  theory  LCI  frame,  respec¬ 
tively.  li/B  is  the  output  apparent  acceleration  measured  by  the 
accelerometers,  and  SfB  is  the  accelerometer  measurement  error. 
The  quartz  accelerometer  measurement  error  model  is  given  by 

'  E0x  +  EXXWX  +  ExyWy  +  EXZWZ 

SfB  =  E0y+EyXWX  +  EyyWy  +  EyZWZ 

-  E0z  +  Ezxwx  +  EZy  Wy  +  EZZWZ 
=  NaccDa  +  ija 

r  1  Wx  Wy  Wz  0  0  0  0  0  0  0  0  1 

Nacc  =  00  0  0  \  Wx  Wy  Wz  0  0  0  0 

[o  0  0  000  0  0  1  IV,  IV,  wj 


(31) 


Da  =  [  Eox  Exx  Exy  E^  E0y  Eyx  Eyy 


where  r'ol,  is  the  position  of  the  actual  launch  site  expressed  in 
the  theory  LCI  frame,  which  can  be  interpreted  as  the  position  er¬ 
rors  between  the  nominal  launch  site  and  the  actual  launch  site. 
Define  p'0  is  the  position  vector  from  the  Earth  center  to  the  nom¬ 
inal  launch  site  expressed  in  the  theory  LCI  frame  and  pl'0,  is  the 
position  vector  from  the  Earth  center  to  the  actual  launch  site  ex¬ 
pressed  in  the  actual  LCI  frame.  Therefore,  r '0I/  can  be  described  as 

ro  i'  =  R\'Po'-Po  (32) 

By  the  definition  of  position  navigation  error,  the  initial  position 
navigation  error  Aro  is  actually  equal  to  -r'0I,,  that  is 

Ar0  =  pl0  —  R'rPtf  =  —PA  (33) 

By  the  definition  of  velocity  navigation  error,  the  initial  velocity 
navigation  error  Av0  is  given  by 

A v0  =  co‘e  X  p’0  -  r\,( (o'e'  X  p'0,) 

=  v'eXP,o-(R','Ue)x(RIrPo') 

=  [corex](p’-R,rp''r)  (34) 

where  (o[  and  a)'"  are  the  earth  rates  expressed  in  the  theory  and 
actual  LCI  frames,  respectively.  Substituting  Eq.  (33)  into  Eq.  (34) 
leads  to 


(35) 

(36) 


where  i 
rad/s. 

Hence,  the  initial  position  and  velocity  navigation  errors  can  be 
described  using  the  to-be-determined  parameter  vector  K  as 

Ar0  =  [  —P  03x12  03x12]  K  =  NroI<  (37) 

A  Vo  =  [  —  Q.  03xi2  03xi2  ]  If  =  NVoK  (38) 


(41) 

^  ^  H-f 

(42) 

where  Eox,  Eoy,  Eqz  are  the  accelerometer  drifts;  Exx,  Eyy,  Ezz  are 
the  scale  factors,  Exy,  Exz,  Eyx,  Eyz,  Ezx,  Ezy  are  the  misalign¬ 
ments;  VVX,  Wy,  Wz  are  the  three  components  of  MfB,  respec¬ 
tively.  Measurement  noise  r)a  is  zero-mean  Gaussian  white-noise 
processes  with  spectral  densities  given  by  <Ta2/3X3. 

By  using  the  error  parameter  vector  I(,  SfB  can  be  rewritten  as 

5fB  =  NdfI<  +  r)a  (43) 

lVd/  =  [03x3  03x12  Nacc  ]  (44) 

By  using  Eq.  (10),  we  obtain 

Rb  =  (/3x3  +  [«x])^  (45) 

Substituting  Eq.  (45)  into  Eq.  (39)  and  neglecting  high-order 
terms  gives 

aw'  =RpbWB-  ( Rpb  +  [ax]Rg)(M7S  - 5 fB) 

^-[ax]RpWB  +  RpSfB 

=  [RpWBx]a  +  RpSfB  (46) 

Substituting  Eqs.  (23)  and  (43)  into  Eq.  (46)  leads  to 
A  W1  =  {[Rpb  WBx]Na  +  RpBNdf}K  +  Rpr,a 

=  CuI(  +  RPBria  (47) 

Integrating  Eq.  (47)  gives  the  apparent  velocity  navigation  error 
of  strapdown  INS 

A Wl  =  J(CuI<  +  RPBr)a)dt «  J  CuKdt 

0  0 

=  J  CudtK  =  C2iK 


(37) 

(38) 


(48) 
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Taking  the  integral  of  Eq.  (48)  again  gives  the  apparent  position 
navigation  error  of  strapdown  INS 

A r'  =  J  C23Kdt  =  J  C21dtK  =  C33I<  (49) 

o  o 

According  to  the  above  analysis,  if  the  gravity  computation  er¬ 
rors  due  to  the  position  errors  are  not  taken  into  consideration, 
the  total  velocity  navigation  errors  can  be  computed  by  using  the 
initial  velocity  navigation  error  and  apparent  velocity  navigation 
error  as 

Av  =  Av0  +  AW1  =  NVoK  +  C21X  =  ( NVo  +  C23)K  =  C2K 

(50) 


A g'  =  g(X 1  +  p'0)  -  g(R\,(X V  +  />£)) 

°S  I  (X'+p') 

=  If  I  [(*'  -  +  (p‘o  -  *rP$)]  (55) 

dSl  (X'+p') 


3g 

3s 


(56) 


where  s  is  the  unit  vector  of  s. 

By  the  definitions,  the  variables  in  the  square  bracket  on  the 
right  side  of  Eq.  (55)  are  essentially  the  total  position  navigation 
errors.  Thus,  using  Eq.  (51),  Eq.  (55)  can  be  rewritten  as 


And  the  total  position  navigation  errors  can  be  written  as 
A  r  =  Aro  +  Avot  +  Ar^  =  NroK  +  N  Vot  K  +  C  31 K 

=  (Nro  +  NVot  +  C33)K  =  C3K  (51) 


The  velocity  and  position  navigation  errors  caused  by  A g‘  are 
given  by 


3.3.  Navigation  errors  caused  by  gravity  computation  errors 

When  performing  the  navigation  computation,  the  gravitational 
acceleration  g  can  be  expressed  in  terms  of  the  radial  and  tangen¬ 
tial  unit  vectors  ls  and  lz  as  follows  [17]: 

g  =  gsh  +  gzh  (52) 

where 

gs  =  -ti/s2[  1  +  J(a/S)2(  1  -  5  sin2  <£)], 
gz  =  -  (2/^/s2)  J  (a/s)2  sin  0, 

H  =  CM  =  3.9860322  x  1014  m/s2, 

J  —  dimensionless  coefficient  determined  experimentally  from 
satellite  observations  (~1.624  x  10-3), 

<j)  =  geodetic  latitude, 

a  =  equatorial  radius  (=6,378.165  km) , 

s  =  distance  from  the  Earth  center  to  the  launch  vehicle. 

Since  the  navigation  position  provided  by  strapdown  INS  is 
different  from  the  true  position  of  the  launch  vehicle,  there  ex¬ 
ist  computation  errors  when  using  the  navigation  information  to 
compute  the  gravitational  acceleration.  In  terms  of  the  definition 
of  navigation  errors,  the  computation  errors  for  the  gravitational 
acceleration  caused  by  the  position  navigation  errors  can  be  repre¬ 
sented  by 

A  gI  =  g(X,  +  pI0)-R,,,g(X,'  +  pI/l)  (53) 

where  Xf  is  the  navigation  position  vector  expressed  in  the  theory 
LCI  frame,  X1  is  the  true  position  vector  expressed  in  the  actual 
LCI  frame,  p\,  and  p'0,  have  been  defined  in  the  previous  subsec- 

When  analyzing  the  computation  errors  of  the  gravitational  ac¬ 
celeration,  it  is  convenient  and  sufficient  to  select  2-body  gravity 
model,  namely, 

SM  =  -j|rS  (54) 

Thus,  using  a  Taylor’s  series  expansion  and  the  invariance  of  the 
vector  length,  Eq.  (53)  can  be  written  as 


j  CuKdt  =  j  C32dt  K  =  C22K 

0  0 

(58) 

1  C22Kdt  =  J  C22dt  K  =  C32K 

(59) 

Therefore,  with  the  consideration  of  the  gravity  computation  er¬ 
rors  due  to  the  position  navigation  errors,  the  total  velocity  and 
position  navigation  errors  in  Eqs.  (50)  and  (51)  can  be  rewritten  as 

Av  =  Av0  +  AM/'  +  Avg  =  (1 Vv„  +  C21  +  C22)K  =  C2K  (60) 
Ar  =  Aro  +  Avo  t  +  Ar1  +  Arg 

=  (Nr0  +  NVot  +  C31  +  C32)K  =  C3K  (61) 

It  follows  from  Eq.  (57)  that  the  matrix  C3  is  required  for  the 
calculation  of  Ag1.  The  previous-time  C 3  computed  by  Eq.  (61) 
is  used  to  calculate  the  Eq.  (57).  It  is  straightforwardly  seen  from 
Eq.  (61)  that  the  initial  value  of  C3  is  equal  to  Nro.  At  this  moment, 
Eq.  (57)  is  essentially  used  to  calculate  the  gravity  acceleration 
computation  errors  caused  by  the  initial  position  navigation  er¬ 
ror,  which  agrees  with  the  actual  situation.  Consequently,  it  can 
be  shown  that  the  gravity  computation  errors  due  to  the  total 
position  navigation  errors  can  be  approximately  compensated  us¬ 
ing  this  method.  It  is  noted  that  the  forward  Euler’s  integration 
method  is  used  to  calculate  the  above  function  matrices.  The  inte¬ 
gration  step  coincides  with  the  navigation  computation  step. 

4.  Estimation  of  error  parameters 

In  this  section,  a  dual  star  correction  strategy  scheme  is  pre¬ 
sented  to  estimate  the  error  parameter  vector  K  and  correct  the 
cumulative  velocity  and  position  navigation  errors.  As  shown  in 
Fig.  3,  the  detailed  scheme  is  summarized  as  follows: 

Step  1 :  When  the  main  engines  shut  down,  the  digital  platform 
misalignment  angle  a k  (includes  0!a  and  ag)  at  shut  down  time 
tk  is  determined  using  the  attitude  information  measured  by  the 
star  sensor,  and  then  fed  into  the  Kalman  filter  as  the  initial  state 
value. 

Step  2:  The  gyro  error  coefficients  Dg  and  the  current  digi¬ 
tal  platform  misalignment  angle  a  are  estimated  by  the  designed 
Kalman  filter.  The  stellar  update  procedure  is  accomplished  by  us¬ 
ing  the  estimated  digital  platform  misalignment  angle  and  INS 
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Fig.  3.  The  workflow  of  dual  star  correction  strategy  scheme. 


navigation  result  R The  inversion  of  initial  digital  platform  mis- 
alignment  angle  ao  (only  includes  a  a)  is  performed  by  using  the 
state  transition  matrix.  Subsequently,  the  initial  localization  and 
misorientation  errors  A  can  be  estimated  by  using  Eq.  (7). 

Step  3:  The  drift  errors  of  the  accelerometers  are  estimated  by 
using  the  accelerometer  output  in  the  post-boost  phase,  and  other 
accelerometer  error  coefficients  are  assigned  as  zero.  Thus,  we  ob¬ 
tain  the  estimates  of  the  accelerometer  error  coefficients  Da. 

Step  4:  The  estimates  for  A,  Dg  and  Da  are  concatenated  to 
form  the  error  parameter  vector  K,  which  is  then  fed  into  the  nav¬ 
igation  error  model  to  correct  the  cumulative  velocity  and  position 
navigation  errors. 

4.1.  The  least  squares  estimation  of  digital  platform  misalignment  angle 
at  shut  down  time 

Although  the  star  sensor  can  work  as  soon  as  the  vehicle  flies 
off  the  atmosphere,  the  stellar  sighting  is  usually  made  after  the 
end  of  the  main  engines  burn  out.  This  is  because  the  rotation 
of  the  vehicle  for  the  sighting  will  affect  the  control  stabilization 
of  the  vehicle  before  the  main  engines  burn  out  and  the  engine 
oscillation  also  will  affect  the  accuracy  of  the  star  sensor.  For  a 
strapdown  stellar-inertial  system,  the  stabilization  of  the  star  sen¬ 
sor  line  of  sight  can  be  performed  by  strict  control  of  the  vehicle 
motion  during  the  sighting,  or  by  allowing  limited  degrees  of  free¬ 
dom  of  the  strapdown  cluster  during  the  sighting  [11], 

The  measurement  model  of  the  star  sensor  is  given  by  [21] 


where  SB  is  the  unit  vector  of  navigation  star  measured  in  the 
body  frame,  S1  is  the  corresponding  unit  vector  expressed  in  the 


theory  LCI  frame.  The  sensor  measurement  noise 
mately  Gaussian  which  satisfies 

qs  is  approxi- 

E{  Vs}  =  0 

(63) 

£{»/5»;I}=ors2[J3x3-(Rfs,)(Rfs')T] 

(64) 

and  £{•}  denotes  expectation.  Eq.  (64)  is  known  as  the  QUEST  mea¬ 
surement  model  which  is  quite  accurate  for  small  field-of-view 
sensors.  The  advantage  of  using  the  model  is  that  the  measure¬ 
ment  covariance  matrix  in  the  EKF  formulation  can  effectively  be 
replaced  by  a  nonsingular  matrix  given  by  crs2/3x 3  [14,13]. 

By  using  the  attitude  transformation  relationship  and  Eq.  (1), 
Eq.  (62)  can  be  rewritten  as 

SB  =  RBRB S1  +  ris  =  RB(l3x3  ~  [ax])S7  +  r}s 

(65) 

Rearranging  Eq.  (65)  leads  to 

R£sB-s7  =  [s7x]a  +  )/s 

(66) 

Hence,  two  star  sensor  vector  measurements  < 
nated  to  form 

ran  be  concate- 

Ya  =  Hacc  +  r)s 

(67) 

SB  =  RBS'  +  ris 


(62) 


(68) 
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The  least  squares  estimation  of  the  digital  platform  misalign¬ 
ment  angle  at  shut  down  time  tk  is  given  by 

ak  =  (HlHay1HlYce  (69) 

4.2.  The  estimation  of  gyro  error  coefficients  and  initial  localization  and 
misorientation  errors 

It  follows  from  the  preceding  analysis  that  the  initial  digital 
platform  errors  caused  by  the  initial  localization  and  misorien¬ 
tation  errors  don’t  change  with  time.  Therefore,  taking  the  time 
derivative  of  Eq.  (17)  or  using  Eqs.  (15)  and  (18)  leads  to 


where  the  estimates  for  a  and  Dg  at  current  time  t„  are  deter¬ 
mined  by  Kalman  filter  in  real.  Therefore,  the  initial  digital  plat¬ 
form  misalignment  angle  oto  can  be  continuously  estimated  as  the 
Kalman  filter  works.  It  follows  from  the  analysis  of  the  digital 
platform  errors  in  Section  2  that  the  initial  digital  platform  mis¬ 
alignment  angle  ao  is  merely  caused  by  the  initial  localization  and 
misorientation  errors.  Up  to  this  point,  the  initial  localization  and 
misorientation  errors  can  be  estimated  by 

A  =  AfX1a0  (78) 

4.3.  The  estimation  of  accelerometer  error  coefficients 


oc  —  —Rg(NgyroDg  +  i ]m) 

=  -(hx3  +  [ax])RpB(NgyroDg  +  riJ  (70) 

Based  upon  the  state  dynamics  and  observations  Eqs.  (70)  and 
(67),  the  extended  Kalman  filter  (EKF)  model  can  be  written  with 
Xa  =  [aT  DT]T  and  w  =  rjl0  as 


f  Xa  =  FaXa  +  Gw 
\Ya  =  H'aXa  +  Vs 

(71) 

where 

5  _  f  [(R>gyroDg)x] 

“  L  °12x3 

-(l3x3  +  [ax])RpNgyrol 

Ol2xl2  J 

(72) 

r  \-(hx3  +  lax])RpB~ 

C=L  . 

] 

(73) 

H’a  =  [Ha  06xi2  ] 

(74) 

The  aforementioned  Kalman  filter  operates  during  the  period 
between  the  end  of  the  main  engines  burn  and  the  start  of  the 
reentry  phase.  From  time  tk,  the  gyro  error  coefficients  Dg  and  the 
current  digital  platform  misalignment  angle  a  are  estimated  by 
using  Eq.  (71),  and  the  initial  state  value  is  Xa(0)  =  [aj  0ix12]t. 
For  the  sake  of  brevity,  the  well-known  Kalman  filtering  equations 
which  can  be  easily  found  in  [9]  are  not  repeated  here.  Therefore, 
the  stellar  update  procedure  is  accomplished  by  the  implementa¬ 
tion  of  the  estimated  total  misalignment  angles  a  and  the  naviga¬ 
tion  computation  result  RB  using  the  following  expression 

R'B  =  (hx3  +  [ax])Rp  (75) 

In  addition,  the  recursion  computation  for  the  transition  matrix 
of  Fa  can  be  described  as 

f  •P(tn,tn-i)™i+Fc/At  +  F20lAt2/2  +  F3aAt3/6  (?6) 

1  0(tn,  t0)  =  4>{tn,  tn- 1)  •  •  •  0(tk,  tfc_i)tf>(t2,  ti)4»(ti,  t0) 


When  the  main  engines  shut  down,  the  thrust  and  atmosphere 
drag  are  assumed  to  be  zero.  Consequently,  it  follows  from  Eq.  (40) 
that  the  accelerometer  output  is  statistically  the  drift  errors  of  the 
accelerometers,  namely, 

L  Eqz  J  j=k  }  k 

where  k  and  n  are  the  shut  down  and  current  time  sequences, 
respectively.  Obviously,  Eq.  (79)  can  be  expressed  as  the  following 
recursive  form 


Since  the  stellar  sighting  cannot  be  used  to  correct  the  ac¬ 
celerometer  error  coefficients,  Eq.  (80)  is  used  to  estimate  the  drift 
errors  of  the  accelerometers.  In  general,  the  drift  errors  are  the 
primary  error  factors  in  the  accelerometer  error  model.  Unfortu¬ 
nately,  the  scale  factors  and  misalignments  of  the  accelerometers 
cannot  be  estimated  by  using  the  integrated  sensor  system  of  this 
paper.  With  the  consideration  of  the  small  magnitude  of  these 
error  coefficients,  the  scale  factors  and  misalignments  are  approx¬ 
imately  estimated  with  zero.  Thus,  we  obtain  the  estimates  of  the 
accelerometer  error  coefficients  as  follows 


Da  =  [  Eox  0]X3  Eoy  0lx3  Eoz  0ix3  ]  (81) 

Then,  the  estimate  of  the  error  parameter  vector  K  can  be  writ¬ 
ten  as 


Finally,  the  cumulative  velocity  and  position  navigation  errors 
can  be  estimated  and  compensated  by  substituting  Eq.  (82)  into 
Eqs.  (60)  and  (61). 


where  0(tn,t„-i)  is  the  state  transition  matrix  from  time  tn-i  to 
time  tn,  At  is  the  sampling  interval  and  to  =  0.  Since  the  Kalman 
filter  has  not  started  to  work  before  the  main  engines  shut  down, 
it  should  be  noted  that  the  estimates  for  a  and  Dg  which  are  used 
to  compute  coefficient  matrix  Fa  during  the  boost  phase  (i.e.,  from 
time  to  to  shut  down  time  tk)  are  zero.  From  shut  down  time  tk 
to  current  time  t„  ( t„  >  tk),  the  estimates  for  a  and  Dg  which 
are  used  to  compute  coefficient  matrix  Fa  are  determined  by  the 
designed  Kalman  filter.  Then,  the  state  transition  matrix  4*  (tn,  to) 
from  time  to  to  current  time  t„  can  be  recursively  calculated  by 
using  Eq.  (76). 

Thus,  the  estimate  of  the  initial  digital  platform  misalignment 
angle  ao  can  be  obtained  in  turn  by 


5.  Simulation  results  and  analysis 

In  this  section,  simulation  results  are  presented  that  analyze 
the  effects  of  the  individual  error  factor  with  respect  to  strapdown 
INS  and  show  the  performance  of  the  proposed  stellar-inertial  in¬ 
tegrated  navigation  scheme.  For  the  simulation  examples  a  launch 
vehicle  is  considered  that  has  a  three-axis  optic  fiber  gyro  and  a 
three-axis  quartz  accelerometer  as  well  as  a  star  sensor.  It  is  as¬ 
sumed  that  two  stars  are  available  for  stellar  sighting  during  the 
entire  simulation  and  the  reference  stars  are  selected  from  the 
Tycho-2  Star  Catalog.  A  rocket  motion  time  history  including  the 
boosted  flight  time  of  180  s  and  the  free-all  time  of  300  s  has 
been  used  in  the  test  cases.  The  total  simulation  time  is  480  s. 

The  basic  simulation  parameters  used  in  the  test  cases  are: 

(1)  The  nominal  launch  azimuth,  latitude  and  longitude:  Ao  = 
10.208°,  B0  =  40°,  X0  =  99°; 
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Table  1 

The  effects  of  the  individual  error  factor  with  respect  to  strapdown  INS. 


Nominal  accuracy  initial  launching  parameter  errors  and  inertial  sensor  drift  errors 

A  =  [50"  20"  20"]t,  Do*  =  D0y  =  D0z  =  0.05° /h,  £0*  =  Eoy  =  E0z  =  tx  10~4  m/s2 

Error  source 

8vx 

8vy 

8vz 

8x 

sy 

8z 

(m-s-1) 

(m-s  ') 

(m-s-1) 

(m) 

(m) 

(m) 

Initial  localization  and  misorientation  errors  A 

0.12 

0.54 

1.54 

-722.5 

203.4 

179.1 

Gyro  measurement  error 

-0.02 

0.12 

-0.13 

-14.4 

35.0 

-48.9 

Accelerometer  measurement  error  S  fB 

0.06 

0.10 

0.12 

13.3 

37.4 

38.4 

Total 

0.16 

0.76 

1.53 

-723.6 

275.8 

168.7 

Low  accuracy  initial  launching  parameter  errors 

and  inertial  sensor  drift  en 

A  =  [-180"  50"  50"]t,  Do*  =  D0y  =  D0z  =  0.5°/h,  E0x  =  f0,  =  E«r  =  1xl 

0  3  m/s2 

Error  source 

8vx 

8Vy 

8vz 

8x 

Sy 

8z 

(m-s-1) 

(m-s-1) 

(m-s-1) 

(m) 

(m) 

(m) 

Initial  localization  and  misorientation  errors  A 

0.32 

1.37 

5.14 

-1805.5 

509.1 

915.6 

Gyro  measurement  error 

-0.30 

1.76 

-2.11 

-162.2 

551.4 

-771.6 

Accelerometer  measurement  error  SfB 

0.40 

0.14 

0.52 

83.9 

70.0 

139.4 

Total 

0.42 

3.27 

3.55 

-1883.6 

1130.5 

283.4 

Table  2 

Navigation  performance  comparisons  for  three  ty] 

pes  of  guidance  schemes. 

Guidance  scheme 

8vx 

8vy 

8vz 

8x 

Sy 

8z 

(m-s-1) 

(m-s-1) 

(m-s-1) 

(m) 

(m) 

(m) 

All-inertial 

0.16 

0.76 

1.53 

-723.6 

275.8 

168.7 

Stellar-inertial 

0.47 

0.06 

0.17 

58.3 

29.5 

66.4 

Stellar-inertial  +  gravity  compensation 

0.03 

0.08 

0.05 

-50.3 

30.8 

21.0 

(2)  Optic  fiber  gyro:  scale  factors  Dxx  —  Dyy  -  Dzz  =  1  x 
10-5,  misalignments  Dxy  =  Dxz  =  Dyx  =  Dyz  =  Dzx  =  Dzy  =  lx 
10-5  rad,  measurement  noise  om  —  2.4  x  10-7  rad/ Vs,  sample  rate 
50  Hz; 

(3)  Quartz  accelerometer:  scale  factors  Exx  —  Eyy  =  Ezz  —  1  x 
10-5,  misalignments  Exy  =  Exz  -  Eyx  =  Eyz  =  Ezx  -  Ezy  =  lx 
10“  5  rad,  measurement  noise  cra  =  2.0  x  10-4  (m/s)/Vs,  sample 
rate  50  Hz; 

(4)  Star  sensor:  measurement  standard  deviation  <rs  =  10", 
sample  rate  1  Hz. 

5.1.  Effect  analysis  of  individual  error  factor 

As  mentioned  above,  there  are  three  primary  error  factors  re¬ 
sulting  in  the  velocity  and  position  navigation  errors.  They  are  the 
initial  localization  and  misorientation  errors,  gyro  measurement 
error  and  accelerometer  measurement  error,  respectively.  In  this 
test  case  three  scenario  simulations  have  been  performed  to  ana¬ 
lyze  the  effects  of  the  individual  error  factor  with  respect  to  the 
accuracy  of  strapdown  INS.  In  each  scenario  only  one  type  of  er¬ 
ror  source  is  added  and  the  simulation  results  are  summarized  in 
Table  1.  Nominal  accuracy  and  low  accuracy  initial  launching  pa¬ 
rameter  errors  and  inertial  sensor  drift  errors  are  investigated. 

As  it  is  shown  in  Table  1,  the  velocity  and  position  navigation 
errors  due  to  the  initial  localization  and  misorientation  errors  are 
much  larger  than  those  due  to  the  inertial  sensor  errors.  Since 
the  flight  time  is  not  long,  the  effects  of  the  inertial  sensor  er¬ 
rors  are  not  large  and  thus  the  initial  launching  parameter  errors 
are  the  primary  error  factors  resulting  in  the  navigation  errors. 
In  fact,  from  the  discussions  in  Section  2,  we  can  conclude  that 
the  navigation  errors  due  to  the  initial  localization  and  misorienta¬ 
tion  errors  are  divided  into  two  parts.  As  the  nominal  accuracy 
test  case  an  example,  the  initial  position  and  velocity  naviga¬ 
tion  errors  caused  by  A  are  Ar0  =  [-691.2  0.05  -357. 5]T  and 
A v0  =  [-0.02  0.02  0.03]t,  respectively.  From  Table  1,  we  can 
clearly  see  that  there  are  velocity  and  position  navigation  errors 
of  another  part  caused  by  A.  This  is  because  the  initial  localiza¬ 
tion  and  misorientation  errors  cause  the  digital  platform  errors, 


and  the  digital  platform  errors  of  this  part  cause  the  navigation  er¬ 
rors,  which  is  consistent  with  the  previous  analysis.  The  navigation 
errors  of  this  part  increase  with  fight  time,  and  the  magnitudes  are 
large,  especially  for  the  velocity. 

Compared  with  the  nominal  accuracy  and  low  accuracy  exam¬ 
ples,  we  find  that  the  effects  of  the  initial  localization  and  mis¬ 
orientation  errors  with  respect  to  strapdown  INS  are  very  large.  In 
addition,  it  can  be  seen  that  the  navigation  errors  due  to  gyro  mea¬ 
surement  error  become  dramatically  large  when  the  gyros  degrade, 
while  the  navigation  errors  due  to  the  accelerometer  measurement 
error  are  still  likely  to  be  acceptable  when  the  accelerometers 
degrade.  This  is  because  the  gyro  measurement  error  causes  the 
digital  platform  errors,  and  the  effects  of  the  digital  platform  er¬ 
rors  with  respect  to  strapdown  INS  are  more  significant  than  the 
accelerometer  measurement  error.  Therefore,  in  order  to  improve 
strapdown  INS  accuracy,  it  is  very  necessary  to  decrease  the  initial 
localization  and  misorientation  uncertainties  and  improve  the  gyro 
measurement  accuracy. 

5.2.  Performance  comparisons  of  guidance  schemes 

There  are  three  types  of  guidance  schemes  used  in  the  fol¬ 
lowing  numerical  examples:  all-inertial,  stellar-inertial,  and  stellar- 
inertial  plus  the  gravity  compensation.  Notice  that  the  stellar- 
inertial  guidance  scheme  herein  is  referred  to  as  the  stellar  update 
scheme  without  the  consideration  of  the  compensation  for  the 
gravity  computation  errors.  The  objective  of  this  test  case  is  to  ver¬ 
ify  the  effectiveness  of  the  proposed  stellar  update  scheme  and  the 
compensation  scheme  for  the  gravity  computation  errors. 

The  basic  simulation  parameters  used  in  this  test  case  have 
been  described  in  the  previous  section,  and  the  nominal  accu¬ 
racy  initial  launching  parameter  errors  and  inertial  sensor  errors 
are  used.  The  navigation  performance  comparisons  for  three  types 
of  guidance  schemes  are  given  in  Table  2.  It  is  clear  from  this  table 
that  the  stellar-inertial  guidance  scheme  can  compensate  the  cu¬ 
mulative  velocity  and  position  navigation  errors  effectively.  From 
the  simulation  results,  we  can  see  that  the  proposed  algorithm 
gives  a  good  estimate  for  the  initial  launching  parameter  errors. 
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Fig.  4.  Position  navigation  errors  for  the  three  types  of  guidance  schemes. 
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Fig.  5.  Partial  enlargement  drawing  of  position  navigation  errors. 


In  another  word,  the  sensitivity  to  initial  localization  and  misori- 
entation  errors  for  stellar-inertial  system  is  much  lower  than  that 
for  all-inertial  system.  This  is  because  launch  latitude  and  longi¬ 
tude  errors  represent  not  translational  errors  but  rotational  errors 
around  the  earth,  and  the  star  sensor  is  capable  of  minimizing  the 
effects  of  rotational  errors.  Compared  with  the  stellar-inertial  and 
stellar-inertial  plus  gravity  compensation  systems,  we  can  see  that 
the  latter  system  offers  a  better  accuracy.  This  implies  the  gravity 
compensation  scheme  can  provide  an  effective  correction  for  the 
navigation  errors,  particular  for  the  velocity  navigation  errors.  The 
position  and  velocity  navigation  errors  for  the  three  types  of  guid¬ 
ance  schemes  as  well  as  their  partial  enlargement  drawing  are  il¬ 
lustrated  in  Figs.  4-7.  The  attitude  estimation  results  for  all-inertial 


and  stellar-inertial  guidance  schemes  are  plotted  in  Fig.  8.  The  at¬ 
titude  estimate  errors  for  the  stellar-inertial  guidance  scheme  are 
within  1  x  10-4  degrees. 

6.  Conclusions 

A  computationally  efficient  dual-star  stellar-inertial  guidance 
scheme  with  the  consideration  of  the  gravity  computation  errors 
due  to  the  position  navigation  errors  has  been  designed  to  esti¬ 
mate  the  error  parameters  and  correct  the  velocity  and  position 
navigation  errors.  The  detailed  mathematical  models  for  the  digital 
platform  errors  and  navigation  errors  caused  by  the  initial  local¬ 
ization  and  misorientation  errors  and  inertial  sensor  errors  are 
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Fig.  6.  Velocity  navigation  errors  for  the  three  types  of  guidance  schemes. 
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Fig.  7.  Partial  enlargement  drawing  of  velocity  navigation  errors. 


derived.  For  the  gravity  computation  errors  due  to  the  position  er¬ 
rors,  an  effective  first-order  approximation  compensation  scheme 
is  addressed.  Compared  with  traditional  stellar-inertial  guidance 
algorithm  based  on  nominal  trajectory  data  and  priori  subsys¬ 
tem  error  statistics,  the  proposed  algorithm  has  the  advantages 
of  higher  precision  and  needless  selection  of  optimal  stellar  sight¬ 
ing  direction.  Simulation  results  indicate  that  the  prelaunch  po¬ 
sition  and  azimuth  errors  are  the  primary  error  factors  resulting 
in  the  navigation  errors  among  others,  and  the  proposed  stellar- 
inertial  plus  gravity  compensation  guidance  scheme  can  provide 
the  accurate  corrections  for  the  velocity  and  position  navigation 
errors. 
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